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ABSTRACT 

We  describe  a  model  predicting  the  output  torque  of  the 
battery-amplifier-actuator-gear  combination  used  on  the 
hexapod  robot  RHex,  based  on  requested  PWM  (Pulse- 
Width-Modulation)  duty  cycle  to  the  amplifier ,  battery 
voltage,  and  motor  speed.  The  model  is  broken  into 
independent  components,  each  experimentally  validated: 
power  source  (battery),  motor  amplifier,  motor,  and 
(planetaiy)  gear.  The  resulting  aggregate  model  shows 
<6  %  Full  Scale  RMS  error  in  predicting  output  torque  in 
the  first  quadrant  of  operation  (positive  torques). 
Understanding  the  key  ingredients  and  the  attainable 
accuracies  of  torque  production  models  in  our  commonly 
used  battery-amplifier-actuator-gear  combinations  is  critical 
for  mobile  robots,  in  order  to  minimize  sensing,  and  thus 
space,  size,  weight,  power  consumption,  failure  rate,  and 
cost  of  mobile  robots. 

Keywords —  DC  permanent  magnet  brush  motor, 
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I.  Introduction 

RHex  is  a  simple  and  highly  mobile  hexapod  robot 
[4]driven  by  six  Maxon  RE  118751  brush-type  20  W 
DC  motors  [3],  combined  with  Maxon  114473  33:1 
planetary  gears,  each  placed  at  the  hip  of  a  compliant 
fibreglass  leg.  RHex’s  suite  of  dynamic  behaviours 
includes  running  speeds  up  to  2.4  m/s  [5],  climbing  up 
to  30  degree  inclines,  bounding  [6],  pranking  [7] [8] [9] 
and  stair  climbing  [10] [11] [12],  Currently,  each 
behaviour  exploits  proportional-derivative  control  of 
the  legs  to  track  position  and  velocity  trajectories 
generated  by  a  clock-driven  state  machine.  While  this 
paradigm  has  resulted  in  impressive  open-loop 
behaviours,  precise  control  of  leg  torques  may  enable 
enhanced  stability  and  efficiency  in  certain  behaviours 
via  online  feedback  control. 

Torque  control  for  each  leg  actuator  may  be  achieved 
in  one  of  three  ways:  (1)  via  feedback  from  a  torque 
cell  placed  between  the  gear  output  shaft  and  the  leg 
attachment;  (2)  via  current  sensing  in  the  motor 
amplifier  and  (3)  via  estimation  based  on  motor  speed 
and  amplifier  duty  cycle.  Since  solutions  (1)  and  (2) 
require  additional  design  complexity  and  expense  due 
to  sensor  integration,  it  is  natural  to  attempt  (3)  first. 

To  this  end  we  present  a  simple  model  for  the 
relationship  between  motor  speed,  amplifier  duty 
factor  and  output  torque,  based  on  a  collection  of 
models  of  each  component  of  the  actuator  system. 


II.  Modelling  Approach 

Physics-based  analytic  models  have  the  advantage 
that  they  provide  modular,  provable  hypotheses  about 
the  operation  of  the  actuator,  which  can  lead  both  to 
improved  model  accuracy,  and  insights  into  how  to 
improve  the  actuator.  What’s  more,  analytic  models 
are  typically  much  lower-dimension  than  automatically 
generated  purely  numerical  or  computational  models, 
providing  simpler  implementation  in  software.  In  this 
section,  we  propose  simple  physics-based  models  for 
each  system  component,  which  will  then  be  evaluated 
experimentally  in  the  subsequent  section. 


A  single  battery-amplifier-motor  combination  may 
be  represented  by  above  electrical  circuit.  To  obtain 
the  complete  model  for  motor  torque  as  a  function  of 
motor  speed  and  duty  cycle,  the  above  circuit  was 
broken  into  the  three  simpler  models  shown  above, 
each  of  which  was  fit  and  validated  with  experimental 
data. 

Battery  Model 

The  battery  model  shown  above  is  representative  of 
the  actuator  system  found  in  the  robot.  This  simple 
internal  resistance  model  has  been  used  during  testing 
and  shows  that  the  battery  has  the  behaviour  of  a 
Thevenin-equivalent  voltage  source  for  short  time 
intervals  during  discharge.  However,  this  model 
cannot  be  used  to  reliably  predict  battery  current  based 
on  voltage  (or  vice-versa)  since  the  internal  resistance 
of  the  battery  appears  to  change  over  the  course  of 
discharge. 

For  the  purpose  of  the  aggregate  model,  battery 
internal  resistance  and  internal  voltage  are  ignored 
because  circuitry  onboard  RHex  measures  Vs  and  Ib, 
removing  the  need  to  estimate  Vs.  The  foregoing 
argument  suggests  that  models  generated  with  a  fixed 
supply  voltage  will  generalize  to  variable  battery 
voltages  in  the  robot,  so  long  as  the  battery  terminal 
voltage  can  be  measured  and  used  in  the  model.  While 
an  estimate  of  Ib  is  currently  available  on  RHex,  it  is 
not  necessarily  desirable  to  depend  on  this 
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measurement,  and  hence  it  is  substituted  for  in  the 
derivation  that  follows. 

Amplifier  Model 


By  combining  the  above  equations,  an  expression 
for  the  motor  terminal  current  in  terms  of  source 
voltage,  motor  speed  and  duty  cycle  is  found: 

,  _d-V,-K ,a>  (6) 

1  Ra+d2Ran¥ 

Output  torque,  based  on  armature  current,  is  simply 
modeled  as: 


K, 


d  •  Vs  —  Ks(U 

R,  +  d2Rnm„ 


(7) 


Gear  Model 


Figure  2:  Detail  of  amplifier  and  motor 

Figure  2  shows  the  electrical  connection  of  the 
PWM  amplifier  (Apex  Microtechnology  SA60  [1]) 
and  motor.  Normally  the  PWM  amplifier  would  be 
modelled  together  with  the  motor,  as  the  winding 
inductance  of  the  motor  is  a  necessary  part  of  the  step 
down  converter  circuit,  filtering  out  the  PWM  carrier 
frequency  to  produce  a  smooth  voltage  output. 
However,  in  this  application  a  second-order  LC  low- 
pass  filter  with  roll-off  frequency  8.4  kHz  strongly 
attenuates  the  100  kHz  PWM  carrier  component, 
leaving  only  a  smooth  voltage  waveform  proportional 
to  the  modulating  signal,  d,  (eq  1)  and  supply  voltage 
at  the  motor  terminals.  As  a  result  of  this  filter,  the 
PWM  switching  waveform  is  completely  removed 
from  the  output,  and  the  system  may  be  modelled  as  an 
ideal  transformer  whose  output  voltage  is  governed  by 
the  buck  converter  equation  [2]: 

VmoMr=d-Vrap,  de  [-1,1]  (1) 

Assuming  no  power  loss  across  the  ideal  transformer, 
we  can  write  t.v  =V  Tory  =  h  .  v  , 

b  amp  motor  a  T  motor  amp 

where  ‘d’  is  the  duty  factor.  Using  this  equality,  an 
expression  may  be  derived  for  the  motor  terminal 
voltage  in  terms  of  the  source  voltage,  motor  terminal 
current  and  duty  cycle: 

Vmo,or  =  d  ■  Varap  =  d  •  (Vs  -  Ib  ■  Rarap )  (2a) 

Vmotor=d-(Vs-dIaRamp)  (2b) 


Motor  Model 


Perhaps  the  simplest  model  for  a  brush-type  DC 
permanent  magnet  motor  is  the  linear  circuit  model, 
derived  by  means  of  Kirchoff’ s  voltage  law: 


(3) 


In  addition,  the  back  emf,  and  output  torque,  x,  as  a 
function  of  armature  current  are  given  by: 

£  =  K  (4a) 

r  =  KtI  (4b) 


Eq.  3  is  further  simplified  by  neglecting  di  and 

*  dt 

substituting  for  back  emf,  a  simplification  that  relies 
on  the  small  winding  inductance  (120  pH),  and  on  the 
low  frequency  command  signal: 

j  _  Vmo,or  -K  .61  (5) 

“  R  a 


Though  more  sophisticated  models  exist  for 
planetary  gears,  we  begin  with  the  simplest  model 
likely  to  produce  accurate  prediction  of  torque: 

Foad  =N-'/'W  (8) 

,  ,  _  tpnotor 

'“d  “  n 

where  N  is  the  gear  ratio  and  r|  is  the  gear  efficiency. 


Based  on  eq’s.  1-6,  the  complete  model  predicting 
output  torque  as  a  function  of  command  signal  and 
motor  speed  is  given  by: 


T 


motor 


N  ■  K 


d  ■  Vs  —  Ksft) 

Ra+d2Ramp 


(9) 


Though  this  model  undoubtedly  neglects  certain 
effects  at  each  stage,  it  is  simple,  requires  little 
sensing,  and  may  be  easily  implemented  in  software. 
Before  proceeding  with  more  detailed  modeling  it  is 
instructive  to  examine  the  performance  of  this  simple 
model. 


III.  Dynamometer  Overview 


Figure  3:  Dynamometer  test  setup 

To  facilitate  testing  of  motors  under  dynamically 
realistic  conditions,  the  authors  constructed  a 
dynamometer  consisting  of  the  actuator  system  under 
test,  torque  and  speed  measurement  apparatus,  and  a 
load  motor  capable  of  torques  and  speeds  well  beyond 
the  range  of  the  device  under  test  (DUT).  The  actuator 
system  was  fully  instrumented  for  measurement  of 
supply  voltage  and  current,  motor  terminal  voltage, 
motor  current  and  motor  case  temperature  using  a 
National  Instruments  PCI-6036E  16-bit  data 
acquisition  card. 
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Using  National  Instruments  Lab  VIEW™  a  program 
was  developed  to  perform  measurements, 
proportional-integral  (PI)  control  of  load  motor  speed 
and  control  of  the  device-under-test  command  signal  at 
a  rate  of  50  Hz.  Accuracies  for  each  measurement 
device  used  in  this  set-up  are  given  in  Table  1. 


IV.  Model  Validation 

Figure  6  shows  battery  voltage  during  the  pranking 
gait  with  the  results  of  a  Thevenin  model  overlaid. 
The  source  voltage  and  internal  resistance  were  fit 
using  the  MATLAB™  function  poly  fit. 

Battery  voltage  during  pronking  --  actual  and  predicted  based  on  battery  current 


DUT  Power  Supply  Load  Power  Supply 


Figure  4:  Dynamometer  electrical  test  set-up 


Figure  5:  Dynamometer  mechanical  test  setup 

The  physical  design  of  the  dynamometer  provides  a 
rigid  connection  between  the  motors  and  load  cell. 
The  load  cell  is  attached  to  the  DUT  by  means  of  a 
variable  length  torque  arm.  The  torque  arm  is  attached 
directly  to  the  gearhead,  providing  a  direct  and  rigid 
link  with  which  to  measure  the  reaction  force  at  the 
load  cell.  The  DUT  and  torque  arm  are  mounted  on  a 
bearing,  to  isolate  the  load  cell  as  the  sole  reaction 
point  for  motor  output  torque.  The  torque  arm  length 
may  be  varied  to  suit  a  number  of  different  torque 
ranges. 


Table  1:  Instruments  used  /  parameters  measured 


Variable 

Type 

Mfr. 

P/N 

Accuracy 

(%  FS) 

(0 

Encoder 

Agilent 

HEDS-5540 

0.32  % 

T 

Load  Cell 

Sensotec 

31/1430-04 

0.25% 

Vs 

V.  Divider 

1.4% 

ib 

Current  Shunt 

4% 

la 

Hall  effect 

CR 

Magnetics 

CR54 10-30 

1  % 

V  motor 

V.  Divider 

2% 

Figure  6:  Battery  voltage  -  actual  and  predicted 
based  on  battery  current 

The  models  described  above  were  fit  to 
dynamometer  data  from  a  single  experimental  ran. 
During  this  trial,  load  speed  was  held  constant  at  5 
rad/s  increments  between  zero  and  40.0  rad/s  by  means 
of  a  proportional-integral  controller.  This  PI  speed 
controller  was  not  expected  to  hold  the  speed  exactly 
constant  when  DUT  torque  was  high.  Instead,  speed 
control  was  used  merely  to  ensure  complete  coverage 
of  the  first  quadrant  of  the  torque  speed  curve.  For 
each  motor  speed,  commanded  duty  cycle  was  driven 
by  a  sinusoid  command  from  zero  to  100  %  and  back 
to  zero.  Model  fits  were  performed  on  only  the  first 
quadrant  of  data  (positive  torques).  As  the  simple 
models  exhibited  slightly  larger  errors  in  the  second 
quadrant,  modeling  for  this  quadrant  will  be  the 
subject  of  future  work.  Figure  7  shows  the  region  of 
the  torque-speed  curve  swept  during  the  test. 

Speed  vs.  Torque 
45 

40 
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30 

25 

ctJ 


10 
5 
0 
-5 

-8  -6  -4  -2  0  2  4  6 

Torque  (Nm) 

Figure  7:  Speed  versus  torque  for  the  DUT 

We  begin  by  examining  the  input-output 
relationship  of  the  PWM  amplifier  described  in 
equation  1.  The  SA60  amplifier  generates  a  locked- 
anti-phase  PWM  signal  in  response  to  a  command 
signal  in  the  approximate  range  [4.0,  8.0]  V  with  the 
centre  roughly  at  6.0  V.  To  determine  the  exact  offset 
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voltage  and  scale  factor,  as  well  as  to  validate  the  buck 
converter  equation  for  this  circuit,  input  voltage  was 
swept  across  its  range  while  measuring  output  voltage. 


Amplifier  open-circuit  output  voltage  vs.  command  signal 


Motor  current  estimation 

To  calculate  the  estimated  motor  current,  the  output 
of  eq  3  was  fit  to  the  real  motor  current  using  actual 
terminal  voltage  and  speed  of  the  motor,  and  by 
varying  the  armature  resistance,  Ra.  A  value  of  1 .65  Q. 
was  found,  as  compared  to  the  datasheet  value  of  1.33 
Q. 

This  model,  together  with  parameters  listed  below, 
resulted  in  the  following  plot  of  estimated  vs.  actual 
motor  current  using  eq.  5  to  determine  the  estimated 
motor  current. 


Actual  and  Estimated  Motor  Current 


Figure  8:  Output  of  motor  amplifier  vs.  command 
voltage —  actual  and  estimated 

By  fitting  a  line  to  the  linear  region  of  the  output 
voltage  versus  command  signal  data  using  the 
MATLAB  function  polyfit,  the  gain  and  offset  of  the 
motor  amplifier  were  found  to  be  5.776  V  and  9.565 
V/V  respectively.  Figure  8  shows  the  quality  of  the  fit; 
the  amplifier  appears  to  be  linear  throughout  the 
middle  region  while  diverging  slightly  from  the  model 
close  to  ±  100  %  duty  factor. 

Terminal  voltage  during  experiment 

Using  the  above  mapping,  the  remaining  parameter 
of  the  amplifier  model  (eq  4a),  internal  resistance,  was 
determined  by  fitting  estimated  terminal  voltage 
during  an  experiment  to  actual,  using  the  MATLAB™ 
Nelder-Meade  minimization  program  Isqcurvefit.  The 
minimization  resulted  in  a  MOSFET  internal 
resistance  of  0.444  Ohms,  close  to  the  Apex  SA60 
datasheet  value  of  0.45  Ohms  [1], 


Actual  and  Estimated  Motor  Terminal  Voltage 
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Figure  10:  Estimated  and  actual  motor  current 
during  experiment 


Output  Torque 

Output  torque  was  measured  with  a  load  cell 
positioned  on  a  torque  arm  87.5  mm  from  the  axis  of 
the  device  under  test.  Using  the  same  process  as  for 
the  other  models,  predicted  torque  was  fit  to  actual 
torque  by  adjusting  the  torque  constant,  and  assuming 
a  gearhead  efficiency  of  80  %.  The  resulting  torque 
constant,  0.0160,  is  close  to  the  datasheet  value  of 
0.0161.  Measured  torque  is  compared  to  that  predicted 
from  the  measured  and  estimated  motor  currents  in 
Figure  1 1  using  the  torque  constant  found. 

Torques  -  real  and  predicted 


t  (s) 

Figure  9:  Estimated  and  actual  motor  terminal 
voltage 


Figure  11:  Motor  torque-  actual  and  predicted 
based  on  measured  and  estimated  motor  current 
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Est.  Torque  Error  (Nm) 


Summary  of  model  fit 

To  assess  the  performance  of  each  model,  RMS 
errors  between  the  predicted  and  actual  results  for  each 
model  were  calculated  for  the  first  quadrant  and  for  the 
first  and  second  quadrants  together.  The  results  are 
displayed  in  Table  2.  In  particular,  in  the  first 
quadrant,  RMS  error  for  the  torque  estimate  was 
5.52%. 


Table  2:  RMS  estimation  errors  (FS  =  full-scale) 


Model 

QI  error 

QI,  QII  error 

V/A/Nm 

%  FS 

V/A/Nm 

%  FS 

Vmo.or  =  d  (Vs  -  d-ia  •  R  amp 

0.930 

3.87 

1.15 

4.78 

J  _Vmotor-Ks® 

”  R. 

0.606 

6.06 

0.680 

6.80 

d-V-Kffl 

r  =  Kt -  , 

Ra+d-Ramp 

0.303 

5.52 

0.553 

10.1 

Unfortunately,  the  surprising  accuracy  of  current 
and  torque  estimation  did  not  extend  to  the  second 
quadrant.  RMS  prediction  error  in  the  first  and  second 
quadrants  together  was  10.1  %  full-scale,  nearly 
double  that  of  the  first  quadrant.  Although  the  exact 
cause  of  the  discrepancy  is  not  yet  obvious,  Figure  12 
shows  that  the  measured  torque  is  consistently  larger 
in  magnitude  than  the  estimated  torque  in  the  second 
quadrant.  Since  second  quadrant  operation  involves 
substantial  current  flow  through  the  MOSFET  body 
diodes,  it  is  expected  that  the  circuit  model  will  be 
slightly  different  for  second  quadrant  operation. 


Torques  --  real  and  predicted 


first  and  second  quadrants. 

V.  Conclusions  &  Future  Work 

While  several  issues  still  remain  to  be  solved,  this 
work  has  resulted  in  a  motor  model  capable  of 
predicting  output  torque  within  5.5  %  FS  during  first- 
quadrant  operation,  while  requiring  no  sensing  at  all, 
besides  motor  velocity. 

Future  work  will  focus  both  on  improving  the 
accuracy  of  the  models  presented  in  this  work  and  on 


other  areas  of  actuator  modeling.  For  example,  a 
model  predicting  motor  core  temperature  as  a  function 
of  case  temperature  and  input  current  will  be  sought  to 
help  avoid  motor  failures. 

Also,  precise  measurements  of  the  efficiency  of  the 
motor  over  the  operating  range  may  help  improve  the 
efficiency  of  the  gaits  used  on  RHex. 
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